#include "test.h"
#include "Global.h"
#include "Dog.h"
#include "SBUS.h"

void Key_Callback(void)
{
}

void MM_TIM_Callback(void)
{
    static uint8_t count;

    if (count++ > 30)
    {
        count = 0;

        UART_Print("%f %f %f\n", global.height, dog.legs[0].H, dog.legs[0].S);
    }
}

void Test_Init(void)
{
    AttachInterrupt_GPIO(KEY_Pin, Key_Callback);
    AttachInterrupt_TIM(&htim3, MM_TIM_Callback);
    HAL_TIM_Base_Start_IT(&htim3);
    UART_Print("Enter test mode\n");
}

void Test_Run(void)
{
}
